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Abstract 

Elastic  networks  consist  of  rigid  bodies  interconnected  with  gener¬ 
alized  springs.  Allowing  more  general  interactions  leads  to  a  theory  of 
rigid  body  systems.  Stiffness  of  an  elastic  system  is  defined  and  com¬ 
puted.  Compactification  of  the  space  of  such  systems  is  conveniently 
interpreted  in  a  grassmannian  framework  as  the  set  of  all  Lagrangian 
planes  in  the  displacement-force  space.  This  compactified  space  con¬ 
sists  of  systems  which  may  be  constrained  by  holonomic  constraints. 


1  Introduction 

It  is  possible  and  desirable  to  develop  a  theory  of  rigid  bodies  interact¬ 
ing  via  generalized  springs.  There  are  examples  of  similar  past  efforts 
([Whi82],  [MS85],  [CK87])  in  robotics.  The  problem  is  to  determine  the 
elastic  forces  which  arise  when  manipulated  objects  are  brought  into  con¬ 
tact.  The  lumped  model  of  this  situation  consists  of  rigid  bodies  represent¬ 
ing  objects  interconnected  by  springs.  A  potential  energy  function  describes 
the  response  of  the  system. 

‘This  work  was  supported  in  part  by  the  Army  Research  Office  grant  DAGG-83-K-0027, 
by  ARO/DARPA  grant  DAAG29-85-K-0096,  and  by  the  National  Science  Foundation 
under  MEA-83- 18972. 

f  Author’s  present  address  is  Systems  Research  Center,  University  of  Maryland,  College 
Park,  MD  20742,  U.S.A. 
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The  theory  developed  here  is  based  on  Lie  groups  and  differential  ge¬ 
ometry,  following  methodology  developed  in  [Arn78]  and  [AM78].  There 
are  conceptual  benefits  associated  with  this  approach  resulting  from  the 
clearly  outlined  mathematical  structure  of  the  problem.  Some  important 
geometric  features  of  elastic  networks  with  holonomic  constraints  will  be 
pointed  out. 

Throughout  this  paper  an  effort  has  been  made  to  avoid  basing  the 
problem  description  on  a  specific  choice  of  coordinates.  This  makes  it  easy 
to  choose  coordinates  adapted  to  the  problem  later  on. 

1.1  Preliminaries 

The  physical  space  is  given  an  Euclidean  metric  by  a  choice  of  length  scale 
and  orientation1.  This  object  will  be  denoted  by  E3  and  a  distinction  will 
be  made  between  E3  and  9i3  for  the  following  reasons: 

•  E3  is  not  a  vector  space  whereas  9i3  is. 

•  E3  is  isotropic  whereas  9J3  =  {(^i,X2,x3)}  has  prefered  directions 
along  Xi  ,  i  =  1,2,3. 

•  E3  is  homogeneous  whereas  5R3  has  a  distinguished  point  -  the  origin. 

•  It  is  desirable  to  use  several  ways  of  identifying  E3  with  9J3  after  the 
problem  has  been  described. 

The  coordinate  maps  x  :  E3  — >  SR3  are  required  to  preserve  the  chosen 
Euclidean  metric  as  well  as  orientation.  There  is  a  good  way  of  visualizing 
the  coordinate  map  x  as  a  coordinate  frame.  The  codomain  3i3  of  x  has  a 
distinguished  point  (the  origin)  and  distinguished  unit  vectors  which  point 
along  the  three  axes  of  Di3.  The  inverse  image  of  those  features  of  0i3  defines 
a  frame  of  x  in  E3,  and  this  frame  uniquely  determines  x. 

This  paper  treats  rigid  bodies  as  open  three  dimensional  submanifolds 
of  E3.  Their  motions  preserve  the  chosen  metric  and  orientation.  One 
can  easily  show  that  a  motion  of  a  rigid  body  uniquelly  extends  to  a  rigid 

1  Length  scale  is  chosen  by  using  meters,  centimeters,  feet  or  some  other  unit  of  length. 
Orientation  can  be  left  or  right  handed.  One  usually  works  with  right  handed  orientation. 
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motion  of  E3.  It  is  well  known  that  the  group  of  such  motions  is  SE(3),  the 
special  euclidean  group  in  three  dimensions. 

The  elements  of  SE(3)  are  maps  g  :  E3  — *  E3  and  the  commutative 
diagram 

E3  -U  E3 
x  l  J,  x 

SR3  -C  JR3 

defines  the  numerical  representation  of  g  in  terms  of  a  specific  choice  of 
coordinates  x.  Since  gx  =  x  o  g  o  x~l ,  changing  coordinates  to  y  gives 

gv  =  V  o  g  o  y_1  =  y  o  x~l  o  gx  o  x  o  y~l 

and  it  is  seen  that  changes  of  coordinates  induce  conjugation  by  y  o  x-1 
on  the  representations  of  rigid  motions.  Note  that  y  o  x1  is  in  itself  a 
representation  of  a  rigid  body  motion,  which  maps  the  coordinate  frame  of 
y  to  the  frame  of  x  when  interpreted  relative  to  either  y  or  x. 

We  shall  consider  a  given  configuration  of  n  elastically  coupled  rigid 
bodies.  Since  displacement  of  each  body  from  this  initial  configuration 
is  given  by  an  element  of  SE(3),  the  configurations  of  this  system  are  in 
SE(3)n. 

2  Systems  and  networks 

This  section  deals  with  statics  of  a  system  or  a  network  of  rigid  bodies.  We 
will  show  that  a  distinction  needs  to  be  made  between  these  two  concepts. 
First,  by  an  elastic  system  we  mean  a  smooth  real  valued  function 

V  :  SE(3)n  — >  JR 

and  the  set  of  all  such  elastic  systems  will  be  denoted  by  S.  This  definition 
allows  elastic  systems  whose  potential  depends  on  their  position  in  space 
even  when  the  relative  positions  of  the  rigid  bodies  remain  fixed.  An  elastic 
system  which  is  free  of  any  such  dependence  will  be  called  a  free  elastic 
system.  Free  elastic  systems  must  satisfy 


V  —  V  O  Lg 
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for  any  left  translation  Lg  by  a  g  £  diag(SE(3)n).  The  diagonal  subgroup 
of  a  product  group  is  in  our  case  defined  by 

diag(SE(3)n)  =  {(<71, . . . ,gn)  €  SE(3)”||0i  =  g2  =  ...  =  gn}  . 

On  the  other  hand,  we  are  clearly  interested  in  those  special  elastic  systems 
which  arise  as  networks  of  interconnected  generalized  springs.  The  set  of 
all  elastic  networks,  Si ,  turns  out  to  be  a  proper  subset  of  S . 

A  free  elastic  network  can  be  represented  by  a  directed  graph  in  which 
each  node  is  a  rigid  body  and  each  edge  is  a  generalized  spring.  Let  I  be 
the  index  set  labeling  the  rigid  bodies  and  J  be  another  index  set  labeling 
the  generalized  springs.  The  potential  energy  in  the  network  is  given  by 

V  =  £  r-V, 

S€J 

where  ry  is  the  pullback  of  the  relative  position  map  associated  with  the 
edge  j,  and 

Vy  :  SE(3)  — *  5R 

is  the  potential  function  of  the  generalized  spring  j.  If  this  edge  is  directed 
from  the  rigid  body  tj  to  the  rigid  body  t2,  the  map  ry  is  given  by 

ry  :  SE(3)n  — >  SE(3) 

•  •  •  >  9n)  —  9h9il 

and  the  pullback  ryVy  =  Vy  o  ry. 

A  general  elastic  network  need  not  be  free,  since  we  can  have  springs 
connecting  its  rigid  bodies  to  the  reference  rigid  body.  This  additional  body 
does  not  move,  but  it  can  absorb  arbitrary  forces,  and  it  can  be  thought  of 
as  the  ground.  If  a  spring  j  is  directed  from  the  reference  body  to  body  t, 
its  contribution  to  the  potential  is  ry  Vy  where  ry  =  7r,-  is  the  projection  from 
the  product  group  SE(3)n  to  its  z'-th  component.  We  will  always  label  the 
reference  rigid  body  by  0,  so  that  the  index  set  I  is  enlarged  to  Iq  =  IU{0}. 

2.1  Equilibrium  and  stiffness 

The  equilibrium  of  an  elastic  system  is  characterized  by  dV  =  0  and  the 
stability  of  such  equilibrium  can  in  most  cases  be  decided  from  the  spectrum 
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of  the  Hessian  d2V  at  that  point.  For  elastic  networks,  the  situation  is 
analogous  but  slightly  more  complicated.  While 

dV  =  ridvi  =  0 
ieJ 

characterizes  an  equilibrium,  clearly  it  does  not  imply  that  individual  gen¬ 
eralized  springs  Vj  are  in  an  equilibrium.  In  fact,  in  most  interesting  situ¬ 
ations  those  springs  do  exert  nonzero  forces.  Thus,  ud2Vj” is  not  a  Hessian 
of  Vj  and  we  need  to  define  it  here.  The  d2Vj  shall  be  represented  relative 
to  q  by  the  matrix  of  second  partials 


where  q  :  SE(3)  — >  Ut6  are  coordinates  on  SE(3)  belonging  to  the  family 
of  exponential  coordinates.  These  exponential  coordinates  can  be  easily 
constructed  around  the  identity  in  a  Lie  group  as  follows.  Given  a  basis 
of  the  Lie  algebra  se(3)  let  q(g)  be  the  components  of  exp_1(^)  relative  to 
that  basis.  Clearly  changes  of  coordinates  within  this  family  of  exponential 
coordinates  are  linear,  and  thus  the  above  matrix  behaves  tensorially  under 
such  changes  of  coordinates. 

3  Elastic  networks 

Let  us  consider  an  elastic  network  which  is  in  equilibrium  at  its  current 
configuration,  i.e.  at  e  €  SE(3)n.  The  cartesian  product  structure  of  the 
configuration  space  SE(3)"  leads  to  a  natural  notion  of  displacement  and 
force  components,  since  the  tangent  and  cotangent  space  at  e  are  direct 
sums  of  n  copies  of  se(3)  and  se(3)*  respectively.  A  displacement  vector 
7  £  se(3)n  has  components  7,-  £  se( 3)  where  i  £  I.  Similarly,  components 
of  a  force  vector  T  £  se(3)*n  are  £  se(3)*. 

The  following  propositions,  which  tell  us  how  to  compute  dV  and  d2V 
from  dVj  and  d2Vj,  axe  easy  to  prove.  The  edge  j  is  assumed  to  be  directed 
from  body  i\  to  body  *2,  where  *1 ,  *2  El  U  {0} 
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Proposition  3.1  The  force  rjdVj  has  components  I\  where  i  E  I  and 


r,  = 


'  -dVj 
<  dVj 
>  0 


if  i  =  *x 
if  i  =  t2, 
otherwise 


This  proposition  follows  from  the  definition  of  r7-  and  the  properties  of  the 
pullback,  and  it  can  easily  be  proven  by  choosing  a  matrix  representation  of 
SE(3)  and  doing  explicit  calculations.  The  immediate  consequence  of  this 
result,  which  is  basically  a  statement  of  the  action-reaction  principle,  is 

Proposition  3.2  At  equilibrium  dV  —  0  the  sum  of  all  forces  exerted  on 
each  free  body  is  zero. 


which  follows  from 

dV  =  Y,r*jdVj  =  0  . 
j£J 

Similarly,  the  contribution  of  Vj  to  the  stiffness  of  V  can  be  determined. 
Note  that  we  can  think  of  d2V  as  a  matrix  of  maps  ka6  :  se(3)6  —»■  se(3)*, 
where  subscripts  indicate  the  components  of  the  direct  sum  se(3)ra  and  its 
dual. 

d2V  =  K  =  (kai)  where  a,  b  G  I 

Clearly,  the  stiffness  of  the  spring  j  will  have  nonzero  entries  kaj  only  where 
a,  6  €  {*1,12}  fi  I.  We  will  denote  this  submatrix  by  K;-. 

Proposition  3.3  The  nonzero  components  of  the  stiffness  r*jd2Vj  belong  to 
the  submatrix  K j  which  is  given  by 


K,= 


(  d2Vj 


-d'v;  \ 

d*vi  ) 


when  both  *i,*2  €  I.  When  the  reference  body  is  involved , 

k  ,  =  (<ev,) 


This  proposition  gives  us  a  recipe  for  constructing  the  stiffness  matrix 
of  an  elastic  network.  We  begin  by  choosing  a  coordinate  frame  x  and 
expressing  all  stiffnesses  in  terms  of  that  fixed  frame. 
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The  diagonal  entries  of  this  matrix  are  sums  of  stiffnesses  of  all  springs 
connected  to  a  particular  body.  Off-diagonal  entries  ka4  are  negative  sums 
of  stiffnesses  of  all  springs  connecting  bodies  a  and  b.  Note  that  this  implies 
that  K  is  not  only  a  symmetric  matrix,  but  also  that  it  is  block  symmetric, 
since  each  kaj  is  a  symmetric  6x6  matrix.  This  clearly  demonstrates  that 
although  U  C  S ,  M  ^  S . 


4  Adapted  frames 


A  generic  spring  defines  an  adapted  coordinate  frame  in  terms  of  which  its 
stiffness  is  brought  to  a  normal  form  which  maximally  decouples  rotational 
and  translational  aspects  of  stiffness  [Lon85],  [Lon88].  An  elastic  system 
presents  the  opportunity  to  use  n  coordinate  frames.  We  define  a  n-frame 
x  as  an  n-tuple  of  frames  £,•  where  i  E  I.  This  coordinate  frame  induces 
a  particular  choice  of  basis  in  se(3)n  which  determines  exponential  coordi¬ 
nates  in  a  neighborhood  of  t  E  SE(3)n.  The  numerical  representation  K2  of 
coordinate  free  objects  like  K  will  be  denoted  by  a  superscript  to  indicate 
which  coordinate  frame  generated  it. 

Under  changes  of  coordinates  x  h-*  y  =  x  o  g  where  g  E  SE(3)”,  the 
matrix  representation  of  d2V  changes  from  K2  to  Kc  as  follows: 

Ks  =  Ad**KfiAd* 

where  Adtf  is  the  Jacobian  of  the  conjugation  map  h  i— ►  ghg~l.  The  product 
structure  of  SE(3)n  shows  that  Adtf  is  a  block  diagonal  map,  where  the  i-th 
block  is  represented  by  the  familiar  6x6  matrix 


where  R  is  the  3x3  direction  cosine  matrix  of  the  *-th  component  of  g 
expressed  relative  to  the  i-th  frame  in  x,  and  t  is  the  associated  translation 
component.  The  notation 


(  ° 
ts 


t2  \ 
0  ~h 

h  0  J 
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is  used  to  convert  a  vector  t  into  the  antisymmetric  matrix  which  represents 
the  cross  product  operator  tx. 

We  can  choose  g  so  that  the  diagonal  blocks  maximally  decouple  rota¬ 
tional  and  translational  aspects  of  stiffness  (see  [Lon85]  or  [Lon88]).  The 
following  proposition  states  this  result. 

Proposition  4.1  It  is  possible  to  find  a  frame  y  such  that  the  diagonal 
blocks  of  Ke  are  of  the  form 


where  A{  =  A\,  C \  =  Cj,  and  Bi  =  +  [6,-  ]  are  3x3  matrices;  where  Di 

is  a  diagonal  matrix  and  bi  G  ker(tr((7j)/  —  C*). 

In  a  generic  case,  tr(C.)  £  o(Ci),  and  Bi  is  a  pure  diagonal  matrix.  Further¬ 
more,  the  origin  of  the  t-th  component  frame  of  y  is  a  uniquely  determined 
point  in  space  called  the  center  of  stiffness.  This  situation  is  discussed  in 
detail  in  [Lon85]  and  [Lon88]. 

5  Building  larger  elastic  systems 

The  set  of  all  elastic  systems  of  order  n  forms  a  vector  space.  Given  two 
elastic  systems  V,  V'  on  n  rigid  bodies,  we  can  construct  a  larger  one  by 
adding  the  potential  functions.  The  composite  system  W  =  V  +  V'  is  very 
interesting,  since  it  naturally  arises  as  the  result  of  a  parallel  as  well  as  a 
serial  connection  of  springs. 

Example  5.1  Consider  two  bodies  connected  by  a  spring.  We  wish  to  con¬ 
nect  another  spring  in  parallel.  The  potential  of  the  two  springs  is  simply 
the  sum  of  their  individual  potentials. 

Example  5.2  Consider  two  springs  connected  in  series  between  bodies  a 
to  b  to  c.  The  potential  of  this  system  is  the  sum  of  the  potentials  of  the 
spring  from  a  to  b  and  the  spring  from  b  to  c. 
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We  will  work  out  the  later  example  in  detail.  There  are  three  rigid 
bodies,  so  the  configuration  space  is  SE(3)3.  We  will  use  I  —  {a, 6, c}  as 
our  index  set  for  the  bodies,  and  J  =  {1,2}  as  the  index  set  for  the  springs. 
The  first  spring  will  be  a  directed  edge  from  a  to  b,  while  the  second  spring 
will  connect  6  to  c.  The  potential  function  of  the  first  spring  is  V  =  r\V i 
while  the  second  spring  has  potential  V'  =  r^.  The  composite  system 
has  potential  function  W  =  V  +  V',  which  can  be  explicitly  written  as  a 
function  of  g  =  ( ga,gb,9c )'  as 

W(ga,gb,gc)  =  (g^gt)  +  V2(gbxge)  • 

The  force  exerted  on  this  system  in  order  to  keep  it  in  the  current 
configuration  is  T  =  (ra,rj,rc)  =  dW  or 

(ra,r4,rc)  =  {-dvudv1  -  dv2,dv2 ) 

while  the  stiffness  of  this  system  is  a  matrix  of  maps  se3  — >  se(3)*  given  by 

j  d2Vx  -d2Vx  0  \ 

-d2F!  d2Vx  +  d2V2  -d2V2  :  se(3)3  — >  se(3)*3  . 

V  0  -d2V2  d2V2 

At  an  equilibrium,  T  =  0  and  therefore  dV\  =  dV2  =  0.  We  can,  however, 
imagine  a  slightly  more  complicated  situation,  where  there  is  another  spring 
number  3  connecting  a  to  c.  This  gives  a  new  system  W'  whose  potential 
is 

W’{ga,gh,ge)  =  Vx{g~lgb)  +  V2(g;lge)  +  V^1^) 
giving  the  following  expression  for  the  force 

r'  =  {-dvl  -  dv3,dv1  -  dv2,dv3  +  dv2) 

and  stiffness 

f  d2V 1  +  d2Vs  -d2V2  -d2V3  \ 

-d2V!  d2Vx  +  d2V2  -d2V2 
K  -d\  -d2V2  d2V2  +  d2V3  J 

This  modified  system  need  not  have  dVj  =  0  at  an  equilibrium  since  internal 
forces  can  be  present. 
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5.1  Vector  space  of  stiffnesses 

The  vector  space  of  elastic  systems  is  infinite  dimensional,  but  the  stiffnesses 
form  a  finite  dimensional  vector  space.  The  dimension  of  this  vector  space 
can  be  determined  for  each  family  of  such  systems  as  a  function  of  the 
number  of  bodies  involved.  Let  us  denote  by  S  and  M  the  spaces  of  elastic 
systems  and  networks  respectively,  and  their  free  versions  by  S/  and  M/. 

Proposition  5.1  The  dimension  of  the  vector  space  of  stiffnesses  is  given 

for  systems  in  S 
for  systems  in  S/ 
for  systems  in  U 
for  systems  in  Hj 

The  proof  of  this  proposition  comes  from  the  observations  that  the  elas¬ 
tic  systems  have  6 n  x  6ra  symmetric  stiffness  matrices,  that  elastic  networks 
have  nxn  block  symmetric  stiffnesses  where  each  6x6  block  is  symmetric; 
and  that  each  free  system  or  network  corresponds  to  a  non-free  version  with 
one  less  body. 

6  Linearized  stability  analysis 

Although  this  section  does  not  discuss  dynamics,  we  will  assume  that  the 
energy  is  slowly  dissipated  by  the  system.  If  a  small  amount  of  energy  is 
added  to  the  system  at  an  equilibrium,  it  is  certain  to  settle  back  to  that 
equilibrium  when  the  potential  energy  forms  a  sufficiently  deep  well.  Thus, 
we  will  say  that  an  elastic  system  V  is  linearly  stable  when  the  stiffness  d2V 
is  positive  definite. 

Obviously,  free  elastic  systems  are  never  linearly  stable,  since  they  can¬ 
not  resist  left  translations  by  those  g  which  move  each  body  the  same  way. 
Both  of  our  examples  are  free  systems  and  therefore  not  linearly  stable. 
However,  if  we  modify  the  system  W'  so  that  the  body  a  is  the  reference 


6n(n  —  1) 

6(n  —  l)(6(n  -  1)  -  l) 

.2  . 

21n(n  —  l) 

21(n-  §(n-2) 
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body,  we  get  a  second  order  system  U  :  SE(3)2  — >  3?  where 
U{9b,ge)  =  V1(gb)  +  V2(gb1ge)  +  V3(gc) 
giving  the  following  expression  for  the  force 

T  =  {dV1-dV2,dV3  +  dV2) 

and  stiffness 

(  d2Vx  +  d2V2  -d2V2  \ 

\  -d2V2  d2V2  +  d2Va  ) 

This  stiffness  matrix  can  represent  a  serial  connection  of  springs  between 
the  reference  body  and  the  body  c.  Suppose  V3  represents  a  very  stiff 
positioning  device  which  is  holding  the  body  c  fixed  relative  to  the  ground. 
The  linear  stability  of  this  system  will  then  depend  on  the  internal  stability 
of  the  body  b.  This  internal  stability  results  when  d2Vi  +  d2V2  is  positive 
definite.  Thus,  we  can  define  that  a  series  connection  of  springs  is  internally 
stable  if  and  only  if  their  parallel  connection  is  stable. 

A  stable  elastic  systems  can  alternatively  be  represented  by  the  compli¬ 
ance  matrix  which  is  obtained  by  inverting  the  stiffness  matrix.  We  shall, 
however,  pursue  another  approach  which  proves  particularly  fruitful  since 
it  generalizes  both  concepts. 

7  Stiffness  graph 

Given  a  spring  whose  stiffness  is  K,  we  will  consider  the  graph  of  K  defined 
by 

G(K)  =  {(7,r)  €  se(3)n  0  «e(3)*n  |  T  =  K7} 

The  graph  of  K  is  a  6n-dimensional  hyperplane  in  a  12n-dimensional  vector 
space.  In  general,  a  space  of  fc-planes  in  m-space  is  called  a  Grassmannian 
and  denoted  by  Grass(k,m).  Therefore,  the  graphs  G(K)  are  elements  of 
Grass(6n,  12  n). 

The  linear  maps  K  are  bounded,  which  implies  that  their  graphs  (?(K) 
form  a  non-compact  subset  of  Grass(6n,  12 n).  In  this  section,  let  us  denote 
by  G($)  the  set  of  all  points  in  Grass[6n,  12n)  obtained  as  a  graph  of 
some  system  in  S.  The  closure  G(S)  includes  some  additional  hyperplanes 
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which  can  be  obtained  as  limits  of  very  stiff  springs.  We  have  the  following 
proposition: 

Proposition  7.1  An  elastic  system  V  of  order  n  subject  to  k  locally  holo- 
nomic  constraints  CK(g)  =  0,  /c  =  1, . . . , k  where  C  :  SE(3)n  — ►  3ft*  and 
where  C(e)  =  0  is  characterized  by  the  hyperplane 

G{d2V\keT(dC))  ®  span(dC) 

Corollary  7.1.1  The  elastic  system  V  —  0  subject  to  holonomic  con¬ 
straints  C  is  characterized  by  the  hyperplane 

ker (dC)  ©  span(dC') 

The  above  corollary  follows  immediately  from  the  preceeding  proposi¬ 
tion,  which  we  shall  prove  here.  Recall  that  dC  is  a  ^-vector  of  1-forms, 
whose  kernel  consists  of  those  vectors  in  se(3)”  which  preserve  the  identity 
C(g)  —  0.  The  span  of  dC,  which  we  will  call  the  internal  force  space , 
consists  of  all  linear  combinations  of  the  1-forms  dCK.  If  we  model  the 
constraint  C  as  an  infinitely  stiff  spring,  we  see  that  it  can  support  any 
force  in  span(dC)  with  vanishingly  small  displacement.  We  shall  consider 
all  points  (7,  T)  €  se(3)n  ©  se(3)*n  which  are  compatible  with  the  stiffness 
~K  =  d2V  and  the  constraints  C. 

First,  notice  that  dC( 7)  =  0  if  the  constraints  are  to  be  satisfied  and 
therefore  7  €  ker(dC).  Thus,  our  hyperplane  has  to  lie  in  ker(dC)  ©se(3)*n. 
Let  us  consider  a  point  7  €  ker(dC)  and  find  all  T  €  se(3)*n  which  are 
compatible  with  7.  Clearly  T  =  K(7)  is  compatible.  On  the  other  hand, 
the  constraint  C  allows  for  any  internal  force  to  be  added  to  that  T.  Thus, 
the  system  is  characterized  by  a  hyperplane  which  is  a  direct  sum  of  the 
graph  of  K  restricted  to  ker(dC)  and  the  span  of  dC,  and  our  proof  is 
complete. 

Another  result  of  interest  to  us  explains  what  happens  when  two  elastic 
systems  with  constraints  are  connected  in  parallel,  so  that  their  stiffnesses 
add  and  both  constraints  have  to  be  satisfied. 

Proposition  7.2  Given  two  systems  Si,S2  €  <2(5)  characterized  by 

S\  ~  G(d2 Vi | ker^Ci))  ©  span(dCi) 

S2  =  G(d2V2 |ker(rfc3j)  ©  span(dC2) 
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their  parallel  connection  is  characterized  by 

G(d?(Vi  +  VjOlker^cjnkerfdCa))  ®  (span(dCi)  ©  span(dC2)) 

This  proposition  follows  from  the  fact  that  the  resulting  system  has 
potential  function  Vi  +  Vjj  and  that  the  space  of  free  directions  is  obtained 
by  intersection.  Note  that  this  result  tells  us  how  to  build  (in  stages) 
representations  of  complicated  elastic  systems  with  multiple  constraints.  In 
particular,  we  now  know  how  to  work  with  elastic  networks  with  networks  of 
constraints.  This  completes  the  development  of  a  formalism  which  enables 
us  to  regard  stiffness,  compliance,  and  constraints  as  different  views  of  the 
same  object,  i.e.  a  point  in  Grass(6n,  12 n). 

8  Lagrangian  planes  and  reciprocity 

There  is  a  natural  antisymmetric  form  u  in  se(3)n  ©  se(3)*r*  given  by 

((7i,r1),(72,r2))w  =  1M72)  -  r2(7i) 

where  7*  €  se(3)n  while  T*  €  se(3)*n.  A  plane  in  Grass(6n,  12n)  is  re¬ 
ciprocal  if  cj  is  zero  for  all  vectors  in  that  plane.  The  Betti  reciprocity 
theorem  [MH83]  applied  to  our  situation  states  that  any  plane  in  G(S)  is 
reciprocal.  By  continuity  of  the  form  u>  we  can  conclude  that  all  planes  in 
G(S)  are  reciprocal.  Furthermore,  the  converse  is  also  true:  a  reciprocal 
plane  in  Grass(6ra,  12n)  is  in  G(S).  To  see  that,  one  need  only  show  that 
reciprocity  is  basically  equivalent  to  the  fact  that  stiffnesses  are  symmetric 
matrices. 

Some  standard  results  [Arn78],  [AM78]  on  symplectic  geometry  can 
be  applied  to  the  symplectic  vector  space  (se(3)”  ©  se(3)*n,u;).  The  null 
planes  (which  are  self  w-orthogonal,  and  also  called  isotropic)  of  dimension 
6n  are  called  Lagrangian  planes.  The  Lagrangian  planes  are  the  highest 
dimensional  null  planes.  We  have  just  shown  that  the  set  of  elastic  systems 
with  constraints  corresponds  to  the  set  of  Lagrangian  planes. 

In  [Arn78]  it  is  shown  that  every  Lagrangian  plane  is  transversal  to  at 
least  one  of  the  26n  coordinate  Lagrangian  planes.  These  coordinate  planes 
are  obtained  by  choosing  a  basis  for  se(3)n  and  then  taking  the  span  of  6n 
vectors  in  se(3)n  ©  se(3)*"  where  the  vector  *  is  either  the  basis  vector  i  or 
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the  corresponding  dual  basis  vector.  We  shall  use  this  result  in  the  next 
section. 


9  Input-output  characterization 

Today’s  robots  are  mostly  position  controlled  devices,  and  static  forces 
which  arise  during  their  operation  can  often  be  determined  from  the  stiff¬ 
ness  matrix.  This  approach  becomes  ill-posed  when  constraints  are  in¬ 
volved.  The  compliance  matrix  approach  has  similar  difficulties  dealing 
with  situations  in  which  there  are  no  restoring  forces.  Nevertheless,  one 
can  always  consider  an  elastic  system  with  constraints  as  an  input-output 
system  provided  the  following  definition  is  adopted: 

Definition  9.1  An  input-output  system  is  a  triple  (A,ft,E)  of  points  in 
Grass(6n,  12 n)  such  that 

1.  £  G  G(S)  is  a  graph  which  characterizes  an  elastic  system  with  con¬ 
straints, 

2.  £  and  A  are  transversal  to  Q. 

The  6 n-hyperplane  A  is  called  the  input  space,  while  fl  is  the  output  space. 
The  hyperplane  E  is  the  graph  of  the  input-output  map  of  the  system. 

This  definition  clarifies  our  intuitive  notion  of  an  elastic  input-output 
system  with  constraints.  When  a  rigid  body  is  manipulated  by  a  robot, 
n  =  1  and  joint  angles  of  the  robot  naturally  define  a  basis  of  se(3)n  (as¬ 
suming  that  the  Jacobian  of  the  forward  kinematic  map  is  nonsingular). 
In  a  position  controlled  situation,  one  would  like  to  consider  se(3)”  as  the 
input  space  and  se  (3)*”  as  the  output  space,  but  this  choice  runs  into  prob¬ 
lems  as  soon  as  constraints  are  introduced.  This  difficulty  was  solved  in 
[RC83]  by  choosing  a  new  input-output  representation  in  which  some  po¬ 
sitional  basis  vectors  have  been  replaced  by  the  corresponding  force  basis 
vectors. 

Proposition  9.1  Given  a  basis  for  se(3)n,  and  a  Lagrangian  plane  E  which 
characterizes  an  elastic  system  with  constraints,  it  is  always  possible  to 
construct  an  input-output  representation  (A,fI,E)  such  that  A  and  Q  are 
coordinate  Lagrangian  planes. 
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This  proposition  is  an  immediate  result  of  the  application  of  the  theorem  on 
coordinate  Lagrangian  planes  cited  from  [Arn78]  at  the  end  of  the  previous 
section.  We  have  thus  proven  that  the  hybrid  position-force  control  strategy 
outlined  in  [RC83]  can  always  be  designed  in  a  well  posed  way. 

Stability  of  a  system  controlled  by  a  hybrid  position-force  controller 
can  also  be  achieved  by  this  method.  The  controller  is  an  elastic  system 
characterized  by  a  plane  A  6  C?(S)  which  is  connected  in  parallel  to  the 
system  E.  The  plane  A  represents  the  m  positional  constraints  P  —  0  where 
P(g)  =  (<7,j ,  , . . . ,  qim )  and  <7,-  are  the  exponential  coordinates  obtained 
from  the  given  basis  of  se(3)n.  Therefore, 

A  =  ker(dP)  ®  span(dP) 


and  since 

E  =  G(d2V\kei(dC))  ©  span(dC) 
the  controlled  system  is  characterized  by 

^(dV|ker((ip)nker(iC))  ©  (span(dP)  ©  span(dC)) 
which  is  certainly  stable  if  ker(dP)  fl  ker(dC')  =  {0}. 

Proposition  9.2  Given  a  basis  of  se(3)n  and  an  elastic  system  with  con¬ 
straints  E  €  G(S)  one  can  construct  a  stable  hybrid  position- force  con¬ 
troller. 

To  prove  this,  note  that  span(dC)  is  transversal  (as  a  A:— dimensional  sub¬ 
space)  to  at  least  one  of  6ra  —  A;  dimensional  coordinate  planes  in  se(3)*n, 
say  plane  Z*.  Let  Y*  be  the  complement  coordinate  plane  in  se(3)*ri  so  that 
Y*  ©  Z*  =  se(3)*n.  The  basis  vectors  which  span  Y*  are  dual  to  the  basis 
vectors  in  se( 3)”  whose  span  is  Y.  Then,  the  hybrid  controller  A  =  Y  ©  Z* 
is  stable,  since  span(dC')  ©  Z*  =  se( 3)*n  and  the  space  of  free  directions  is 
zero. 

The  controller  A  is  a  coordinate  Lagrangian  plane  which  is  transversal 
to  E  and  we  can  use  it  as  the  output  space.  Similarly,  Y*  ©  Z  is  another 
coordinate  Lagrangian  plane  which  is  transversal  to  A,  and  we  can  think  of 
it  as  the  input  space. 
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10  Conclusions 


We  have  shown  how  statics  of  a  system  of  n  rigid  bodies  with  constraints 
can  be  described  by  a  Lagrangian  plane  in  the  displacement-force  space 
se(3)n  ©  se(3)’",‘.  The  theory  developed  here  can  guide  the  development  of 
computer  programs  capable  of  analyzing  of  such  systems.  The  coordinate 
independent  description  of  the  general  problem  can  easily  be  expressed  in 
terms  of  any  given  choice  of  basis  vectors  in  se(3)n,  and  in  a  generic  case, 
a  particular  adapted  frame  can  be  found.  We  have  also  shown  how  to 
construct  a  stable  hybrid  control  strategy  which  guarantees  a  valid  input- 
output  description  of  a  given  elastic  system  with  constraints. 
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